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1.0 SUMMARY 


The 'Payload Deployment and Retrieval System Simulation' (PDRSS) program, 
which Is currently in use for simulating the Remote Manipulator System (RMS) 
does not have the capability to update the flexibility coefficients as the 
ann design changes. Any standard structural program can be used to calculate 
these coefficients. However, most of these structural programs require 
large computers and the associated turn-around time and expense make them 
unattractive for calculating just the flexibility coefficients. A program 
(called 'Program A' in this report) has been developed on the Hewlett Packard- 
9825 to calculate these flexibility coefficients. 

Another program (called 'Program B ' ) has been developed to cut down the 
numbei of PDRSS runs required to simulate various RMS maneuvers. This program 
calculates the end-effector flexibility and the joint flexibility terms for 
the torque nlotor model of each joint for any arbitrary arm configuration. 
Instead of making expensive PDRSS runs for all the required arm operations, 
program ' B ' can be used to select those which involve stiffest arm config- 
urations. Figure 2 shows the use of programs 'A' and ' B ' In conjunction with 
the PDRSS program. Flexibility coefficients calculated by 'A' are required 
as Input to ' B ' . 

Section 2.0 describes the purpose of this task in greater detail. Equations 
used in 'A' and ' B ' are presented in Section 3.0. 

Appendix A discusses the mathematical basis for the equations used in 
'A' and 'B'. 

Appendix B familiarizes the user with the procedure required to access the 
programs 'A' and 'B', the input parameters required and the output obtained. 

Appendix C presents the results which are obtained through the use of 
programs 'A' and ' B ' for two example problems and compares them with the 
PDRSS results. Appendix D contains the listing of programs 'A' and ' B ' . 


1 . 



2.0 INTRODUCTION 


The 'Payload Deployment and Retrieval System Simulation' (PDRSS) program, 

which Is currently In use for simulating the RMS, uses a five beam model to 

represent the arm. In this model, flexibility coefficients for each of the 

five beams are required to simulate the arm motion and the loads generated 

during any commanded arm operation. At present, the flexibility coefficients 

bullt-lnto the PDRSS program, have been calculated by assuming beam one Is 

between the attach point and the shoulder pitch joint and is composed of 

three different segments. Similarly, beam two is between the shoulder pitch 

joint and the elbow pitch joint and is composed of three segments; beam three 

is between the elbow pitch joint and the wrist pitch joint and consists of 

three segments; beam four is between the wrist pitch joint and yaw joint and 

consists of two segments; beam five is between the wrist yaw joint and the 

end effector and consists of three segments. The above model is shown in 
Figure 1. 

The PDRSS program does not nave the capability to update the flexibility 
coefficients as the arm design changes. Any standard structural program 
can be used to calculate these flexibility coefficients but most of these 
programs use large computers and the turn-around time and expense involved 
make them unattractive. Therefore, it was recognized that a program is needed, 
which could be run on a desk-type computer, to calculate the flexibility co- 
efficients for the arm modeled by any given number of beams each consisting 
of an arbitrary number of segments. This led to the first objective of 
this task, i.e., to develop a program on the Hewlett-Packard 9825 to cal- 
culate the flexibility coefficients. The second objective of this task was 
to develop the capability to determine the arm flexibility in any given con- 
figuration, i.e., deflection at the end-effector due to unit loads at the 
end effector for any arbitrary arm configuration. This information would 
be useful in makinq a judgement regarding the arm stiffness and thereby 
anticipating its natural frequency and loads in a given configuration. 
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For example, to assure that design loads are not exceeded during arm 
operation, instead of making expensive PDRSS runs for all the required arm 
operations we can select those which involve arm configurations with higher 
stiffnesses. To this end another H. P. program has been developed which 
determines end-effector arm flexibility, when given the individual beam 
flexibility coefficients and the arm configuration (characterized by 
specifying six joint angles). This program has been further extended to 
determine the flexibility coefficients for the torque motor model at each 
joint. When studying simplified simulation techinques which could be used 
instead of PDRSS, flexibility for the torque motor model can be calculated 
with the above program. The use of programs 'A' and * B * in conjunction with 
the PDRSS program to simulate the arm is shown in Figure 2 . 



Figure 1 
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3.0 ANALYSIS 


Equations used In programs 'A' and 'V are presented below. Program 'A' uses 
the standard load/deflection re’atlonship for a beam to calculate the 
flexibility coefficients. Three rotational and two displacement degrees of 
freedom are assumed for each beam. In the RMS simulation it is assumed that 
the displacement along the beam axis is negligible; therefore, the 
flexibility coefficient in the axial direction is taken to be zero. Program 
• B * uses the flexibility coefficients of each beam to calculate the combined 
arm flexibility at the end-effector. Program * B ' takes into account the 
effect of arm configuration by using transformation matrices to transform all 
the flexibility coefficients into the wrist-pitch system. Through the use of 
the Jacobian matrix, program ' B ' uses the end-effector flexibility 
coefficients to calculate the flexibility at each of the six RMS joints. It 
further calculates, the joint flexibility terms for the torque motor model at 
each joint. Appendix A presents the derivation which leads to the equations 
used in program 'A' and 1 B ' . 


3.1 PROGRAM 'A 1 - 

For a beam consisting of n segments, the load/deflection relationship is 
given by 






y 1 “’K'k.'i 

o L 1 ) (pl 1 ) 


0 ) 


5 


where 


|‘ 2 „/2EI 2 i3 „/6EI 2 

l l n/El? t2 n/2El2 



Superscript n ■ Number of Segment 

Subscript L * L.H.S. of Segment 

Subscript R ■ R.H.S. of Segment 

• * • 

l n ■ Length of nth Segment 

E ■ Young's Modulus, nth Segment 

12 « Moment of inertia About the Z-Axis, nth Segment 

Yr° ■ Displacement at R.H.S. of nth Segment In the Y- 
Dlrectlon. 

$R n * Rotation at R.H.S. of nth Segment About the Z-Axis 

Mr 0 * Bending Moment Applied at R.H.S. of nth Segment About the 

Z-Axis 

FR n * Force Applied at R.H.S. of nth Segment In the Y-DIrection 

Another Equation, Similar to (1) can be written for bending about the 
Y-Axis. The only difference would be the moment of Inertia about the 
Y-Axis, Ij, Instead of I~. For torsional flexibility, the torque/rotation 
relationship Is given by 

„ n IK 

0 R n - E t r " (2) 

K«1 G* J K 
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where • Rotation at R.H.S. of nth Segment About the Beam Axis 

“ Applied Torque at R.H.S. of nth Segment About the Beam Axis 
G n ■ Shear Modulus of nth Segment 
J n ■ Polar Moment of Inertia of nth Segment 

In Program 'A' Equations (1) and (2) have been programmed to calculate 
flexibility coefficients of a beam consisting of arbitrary number of segments 
n. 


3.2 PROGRAM 'B* 


For the RMS consisting of five beams, end-effector flexibility (ye) in the 
Wrist-Pitch System Is given by 


1 y eI 
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where -r<c • - Z 

15 K*1 * 


and rj< 


0 -r K * 
r K 3 0 

I- r K ? r K 


1 



where r«J ■ Length of (K ♦ l;th Beam 
In jth Direction, K ■ 1, 2, 3, 4 
J - 1. 2. 3 


Superscripts j « 1, 2, 3 Represent 
X, Y, Z Axes of the Orbiter Coordinate 
System, Respectively. 
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Twi » 1 " 1» 2, 3, 4, 5 are the transformation matrices from the beam 
1 system to the W. Pltcn system, yil 1 * Y12* . Y22 1 . 1 ■ 1, 2, 3, 4, 
5 are the matrices of flexibility coefficients of beam 1. 


The Joint flexibility matrix Is given by 

{yj} • {j * 1 } {ye} {j T ''} 

and the flexibility term for the torque motor model at each joint Is: 


(4) 


*i e ■ rij 


22 


hi 


Y <J 


21 


1 ■ 1. 2. 3. 4, 


(5) 


Is a 5x5 matrix derived from 


<1 


by deleting the 1th row and column. 


} 

1 being the number of the joint, {yij 21 } 1* a 5x1 matrix derived from |yj| b y 
talcing the 1th column and deleting the 1th element. 


Equations (3), (4) and (5) are used In Program * B ' to calculate the end- 
effector flexibility. Joint flexibility and the flexibility terms for the 
torque motor model . 
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4.0 CONCLUSIONS AND RECOMMENOAl IONS 


Two computer programs, 'A' and ' B ' , on the Hewlett-Packard 9825 have been 
developed Incorporating the computations described In the previous sec- 
tion. The Input and output data formats of these programs are described 
In Appendix B, sample results are In Appendix C and Program Listings are 
In Appendix D. Conclusions and recommendations related to the use of 
these programs are summarized below. 

Program 'A' Is used to calculate flexibility coefficients for the example 
problem 1 In Appendix C-l. Flexibility coefficients for beams 2 and 3 as 
calculated by Program 'A* are presented In Appendix C-3.1 along with corres- 
ponding flexibility coefficients currently used In the PDRSS. Comparing 
the two we conclude that they match closely. The difference In 2nd and 3rd 
decimal placr- (8 and 9 significant figures) Is attributed to different 
number t>f .gniflcant figures In the two machines. 

Program * B ' Is used to calculate the end-effector arm flexibility for the 
example problem 2 In Appendix C-2. For comparison, end-effector arm flexibility 
calculated by Program * B * Is presented In Appendix C.3-2 along with end-effector 
'lexblllty calculated by PDRSS. We again conclude that these flexibility 
coefficients match almost exactly. Again, the Insignificant difference Is 
attributed to the different machines used to compute these coefficients. 

We have concluded from the execution of the sample problems that the formulation 
and Implementation of the programs Is correct. The programs are available for 
use. Further Information may be obtained by contacting the author, Lallt Kumar, 
at McDonnell Dciglas Technical Services Company, 488-5660, Extension 216. 
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APPENDIX A 


APPLICABLE E QUATIONS 


V 

r T 



riGURF A-l 


For a cantilever beam of length shown In Figure A-l, the deflection due to 

end load F Is given by 
13 


t F * 


3EI 2 ; 

The deflection due to moment Mis : 


(A-l) 



it 

Y M * M 

2EI 2 

The total deflection is : 
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(A-2) 


13 it 

Y F ► Y M = F ♦ M 

3EI 2 2FI 2 


(A- 3 ) 


Similarly Total Rotation/Slo)e is given by: 
it i 

♦ * - F + — M (A- 4 ) 

2EI 2 EI 2 


where E * Young's Modulus 

I 2 = Moment of Inertia of the Beam Crossection About the Z-Axis 
Ij * Moment of Inertia of the Beam Crossection About the Y-Axis 


A-l 


For an arbitrary uniform beam segment loaded as shown In Figure H-? 


Mi. 


C 


5 


Mr 


Figure A-2 


t l 2 

4>R * ♦L ♦ — Mr - Fr 

EI 2 2EI 2 


Fa 


(A- 5 ) 


l 2 l3 

YR " \ + U L * — Mr - — Fr 

2EI 2 3E 1 2 


( A - 6 ) 


m l * ^ - *f l 


(A-7) 


h ■ Fr* 


(A-8) 


Rearranging Equations A-5, — A-8 and writing In matrix form 



A-2 



whore l 


|l *| l 3 /6El2 

|o lj’ “ |l/EI 2 t 2 /?E! 2 



0 

0 


Similarly for two consecutive segments 




but 


!“'! • H 

M M 


Therefore by substitution 


(A-ll) 


(A-12) 


(A- 13) 



Superscript Refers to the Segment Number 
Subscript L ♦ L.H.S. of Beam 
Subscript R ♦ R.H.S. of Beam 


(A- 14) 



(A- 15) 


A-3 



By Pef i n i t i on 


l«l • |a| |r| 

6x1 6x6 6x1 


(A- 16) 


Where 6 is the deflection due to load F and A is a 6x6 matrix of 
flexibility coefficients. Writing A-16 in expanded form 



A 11 

a 12 

a 13 

a 14 

A 15 

A 16 

A P1 

a 22 

a 23 

a 24 

a 25 

a 26 

a 31 

a 32 

a 33 

a 34 

A 35 

A 36 

A 4 i 

a 42 

a 43 

a 44 

a 45 

a 46 

a 51 

a 52 

a 53 

a S4 

a 55 

a 56 

a 61 

A62 

A63 

a 64 

a 65 

a 66 



(A- 17) 


In our model we assume zero flexibility along the beam longitudinal axis, 
say, X-axis. A^ ■ 0, i« 1, 2, 3, 4, 5, 6 


Since, by definition A is syiiinetr ic, A 14 ■ A4 1 ■ 0, i • 1, 2, 3, 4, 5, 6 

Also, for a beam A^ » A^ ■ A14 ■ Ajg ■ Ajg » 0 

a 23 * a 24 " a 25 “ 0 

a 34 " a 36 ■ 0 

a 56 * 0 

And due to symnetry A?i » A31 ■ A41 ■ Agj « Agi ■ A32 ■ A42 • A52 

• A43 * a 63 " A 6b " 0 
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Therefore the f lexfbi lity nutr ix A reduces to 



0 

0 

0 

0 

*22 

0 

0 

0 

0 

*33 

0 

*35 

0 

0 

0 

0 

0 

*35 

0 

*55 

*26 

0 

0 

0 



(A-18) 


i.e., seven non-*ero flexibility coefficients need to be determined. For a 

single beam segment, using equations A-5 and A -6 

t 1 13 


*22 


And 


■ . *33 

Eli 

■ . *55 

ei 2 

3EI 2 


13 

12 

12 

(A- 19) 

- . . * 26 

3E 1 1 

’ • *35 

2EIi 

m m > ■■■ ■■ 

2E1 2 



l 



■ Torsional Flexibility ■ — 

GJ 



i beam consisting 

of more than one 

segment, ?< 22 ' 

A 33’ A 55 • A 66 ’ A 35 * A 26 

:alculated using equation A- 1 5 and rewriting it 

In the form of equations 

A- 6 , A-7, A -8 




l \ 

l 2 

X r - -i. - 

l n 

(A-20) 

AH 7" 

G 1 J 1 

G 2 J 2 

6 n J n 


) 


The above equations have been programmed to calculate the flexibility 
coefficients of beams given the lengths. Young's modulus, moment of inertias 
about the two bending axes, shear modulus ( 6 ) and polar moment of inertia (J) 
of each segment. 
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end-effector arm flexibility 


The flexibility matrix, A for a beam can be written in the following form 

j*ll Y12| 

*12 t j 


A ■ 


where Yj j 


|A U 0 0 j 

-jo a 22 0 j, 

(o 0 A 3J ) 


/0 0 0 \ 

*12 " j 0 0 

lo Aj$ 0 ) 


(A- 21) 


And Yp2 


I 


0 0 
0 A 


I 


(o 0 A**) 


From Reference 1, Page 14, the End-Effector Flexibility {Yfc|is given by 


, Ye , . M 1 °H T,i 


fl j-r |5 1|| 0 T w( jjlr u |T t 23 '||0 lJ|o I 


T iW 0 (I 1 r i5 


(A-22) 



r^J ■ length of K*1 beam in jth direc 
tion Superscripts 1, 2, 3 Represent 
X, Y, Z Axes of Orbiter Coordinate 
System, Respectively. 
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Tbi . 1 ■ 1. 2 . 3. 4, 5 

is the transformation matrix from beam i system to W. Pitch system 

Yji Y 12 Y 22 1 1 ■ 1, 2, 3, 4, 5 

Are the matrices of flexibility coefficients of beam i. 

Equation A-22 has been programmed to determine the End-Effector flexibility 
given the length of each beam, orientation of the arm (characterized by 6 
Joint angles) and the seven flexibility coefficients for each beam. 

The joint flexibility matrix |Yj}is derived as follows: 

The End-Effector flexibility relationship can be expressed as 

{ S e} - ( T e) { F e) 

Where {* e }is a 6x1 matrix containing three rotations and three deflections, 
{F c | is a 6x1 force matrix containing three moments and three forces; 
j Y^J is a 6x6 flexibility matrix. 

End-Effector deflections can be related uniquely to joint rotations using the 
rate law (valid only for 6 joint system), Reference 2. 

MM * {*«} (a-?4) 

jj} 3 6x6 Jacobian matrix for the given arm (6 Joints) configuration. 

{ 30| » 6x1 matrix of rotations at each of the 6 Joints 
Similarly End-Effector loads can be related to joint torques 

{ T p | B {Jf^ l^el • J^p} * 6x1 Matrix of Joint Torques (A-25) 

Or {J} T_1 )V| 3 {F e } ( A- 26 ) 

Substituting for F e and & e in Equation A-23, we get 


A-7 


|J||W| * |Yp| |J | T |tf| 

I 

Or j&O} • jj}- 1 { Yc j jJ} 1 ' 1 jxp} (A-27) 

From A-27 ) Y j| - jJ' 1 } {YE }l J j 1 " 1 (A-28) 

Equation A-28 has been used to calculate the joint flexibility. 

Flexibility terms for the torque motor model at each joint are calculated 
from {\jjmatr1x as follows: 

Yi * Y1 1 j * {Yl/ 1 } {Y1 0 ? } 1 |Yl/ 1 } 1 " 1. 2, 3. 4, 5, 6 (A-29) 

* 

22 

Where { y i j } Is the 5x5 matrix derived from j Y j|by deleting the 1 th row and 

21 

column, 1 being the number of joint. | Y ^ j Is the 5x1 matrix derived 
from J Y j| by taking the 1 th column and deleting the 1 th element. 
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APPENDIX B 


PROGRAM USAGE 

The following programs may be obtained from L. Kumar, 488-5660, Ext. 217, 

8.1 CALCULATION OF FLEXIBILITY COEFFICIENTS - PROGRAM A 

To access the program and run it, tli? following procedure is required: 

Step 1 Load the tape on HP-9825, labeled side of the tape toward the back of 
HP-9825. 

Step 2 Turn on the calculator and the printer. 

Step 3 Access the appropriate track number by typing trk * 1 and pressing 
the EXECUTE key. a indicates a blank space. 

Step 4 Load the appropriate file by typing ldf a 3 and pressing the EXECUTE 
key. 

Step 5 Run the program by pressing the RUN key. 


'.CEDING PAGE BLANK NOT FILE, 


B-l 


Input Paramours 


Once the program is running several self-explanatory messages are dlsplayi 
The following explains the displays and inputs required sequentially. 


HP-9325 Display Display Duration Response Required From User 


(1) Beam One, First Cross Axis 2 Secs 

(2) No. of segments 

(3) Notation used for segment K 2 Secs 

(4) L [K] * Length, Inches 2 Secs 

(5) E [K] ■ Youngs Mod., Psi 2 Secs 

(6) G [K] ■ Shear Mod., Psi 2 Secs 

(7) I [K] a Moment of Iner., 2 Secs 

(IN) ♦ 4 

(8) J [K] ■ Polar Momt. of 2 Secs 

Iner., (IN) * 4 

(9) L [1] 

(10) E [1] 

(11) G [1] 

(12) I [1] 

(13) J [1] 


No Response Required, Info only 

Input the number of segments 
In beam 1 and press "Continue** key 

No resp. req.. Info only 

No resp. req., Info only 

No resp. req.. Info only 

No resp. req., Info only 

No resp. req.. Info only 


No resp. req., Info only 


Input the length of Seg. 1, Beam 1 
and press "Continue" key 

Input Young's Mod. of Seg. 1, Beam 1 
and press "Continue" key 

Input shear Mod. of Seg. 1, Beam 1 
and press "Continue" key 

Input moment of inertia of Seg. 1, 
Beam 1 About Cross Axis, 1, Press 
"Continue" key 

Input polar moment of inertia of 
Seg. 1 Beam 1, Press "Continue" 
key 


The last five variables will be displayed repeatedly until L[K], E[K], G[K], 
I[K] , J[K] for the Kth segment, Beam 1 have been input. K ■ No. 
of segments in Beam 1 which was entered in Line 1. 
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i9-982$ DISPl I] 


01 splay Duration Response Required From User 


(14) Moment of Iner. -2nd 2 Secs No resp. req., Info, only 

Cross Axis 

(15) I [1] Input Momt. of Iner. Seg. 1, 

Beam 1 about cross axis 2, 
press “ 00011006 “ key 

(16) I [2] 

(17) I [K] Input Momt. of Iner. Seg. K, 

Beam 1 about cross axis 2, 
press "Continue" key 

(18) Beam two, first cross axis 2 Secs No resp. req.. Info, only 
Display will start again from Line (2). Input parameters for Beam 2 from 
Line (2) to (17). 

(19) Beam three, first cross 2 Secs No Resp. req. Info, only 
axis 

Again it will go back to Line (2). Input Beam 3 parameters from Line (2) to (17). 

(20) Beam four, first cross axis 2 Secs No Resp. req. Info, only 
Start again from Line (2). Input Beam 4 parameters from Line (2) to (17). 

(21) Beam Five, First Cross Axis 2 Secs No Resp. req. Info, only 
Start again from line (2). Input Beam 5 parameters from Line (2) to (17). 

(22) End 

NOTE : Currently the program has been set-up for five beams but it can easily 
be extended to any number of beams by simply changing the beam counter 
variable TO 
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Program Output 

Referring to Eqn. A-15, for any beam consisting of several segments we can 
write 



where L Is a 2x2 matrix 
K ■ No. of segments, {l K | 



given by |l K | {L K-1 J. - -{ L 1 1 
(1 l K) * 

io 1 1 


a is a 2x2 matrix given by 

tf ■ |L"| 1L k **( (L 2 Ha 1 ! ♦ |L K I )L i< ' 1 | ...|o 2 ||l'| * ...|o k ||L i< -1|...{L 1 | 

The program outputs matrix L and a in each cross-axis for beam 1 to beam 
5, followed by flexibility coefficients Ganna [1]... Gamma [7], 
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Interpretation of Gamma 1 , I « 1, ?, 3, 4, 5, 6 , 

Numerical values of Gamma 1 , 1 »1 , 2, 3, 4, 5, 6 , 7 as calculated by the 
program are correct but the signs for some of the Gammas might be reversed 
due to loading direction chosen In Equations A-3 and A-4. The following 
signs are associated with each of the Gammas. 


Gaima 1 , 1 ■ 1, 2, 3 are the rotations In radians about axes x, y, z or x, 
z, y (depending upon whether first cross axis Is the Y-Axis or Z-Axis) for 
unit loads In Ft-Lb applied about axes x, y, z or x, z, y respectively. 

These three Gammas are always positive. 


If first cross axis Is the Y-Axis Gamma 5 * Oisp. In Z-Oir. For Unit 

Force In Z-Dir. (FT/LB) Always Posit ive . 
Gamma 4 ■ Oisp. In Y-Dir. For Unit 

Force in Y-DIr. (FT/LB) Always Positive . 

Gamma 6 ■ Rot. About Y-Axis For Unit 
Force in Z-Dir. (Rad/LB.) Always Negative . 
Gamma 7 » Rot. About Z-Axis For Unit 
Force in Y-Dir. (Rad/LB.) Always Positive . 

If first cross axis is the Z-Axis Gamma 5 « Disp. in Y-Dir. For Unit Force 

in Y-Dir. (FT/LB) Always Positive . 

Gamma 4 « Disp. 4 n Z-Dir. For Unit Force 

In Z-Dir. (FT/LB.) Always Positive . 

Gamma 6 ■ Rot. About Z-Axis For Unit Force 
In Y-Dir. (Rad/LB.) Always Positive . 

Gan 3 7 « Rot. About Y-Axis For Unit Force 
In Z-Dir. (Rad/LB.) Always Negative . 
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B.2 CALCULATION OF END EFFECTOR FLEXIBILITY - PROGRAM B 


To access the program and run It same procedure as on cage 11 Is to be 
followed. In step 4 instead of typing ldf 3 type ldf 2 and press the 


EXECUTE key. 

Input Parameters 

H.P.-9825 Display Disp. Duration 

3ecs 

(1) Input angles and lengths 2 

(2) YO 

(3) Y1 

(4) Y2 ’ - 

( 5 ) *3 

(6) Y4 

(7) Y5 

(8) Y6 

(9) Y7 

(10) V8 

(11) Yg 

(12) YlO 

d3) m 

(14) Print Transf.-Beam 1 2 

to 0.*b Sys? 

(15) 1 * Yes 0 * No 2 

(16) Y22 


Response Required From User 

No Resp. Req. info, only 

Enter Outb'd roll angle, p^ess "Continue" 

Enter shoulder yaw angle, press "Continue" 

Enter shoulder pitch angle, press "Continue 

Enter elbow pitch angle, press "Continue" 

Enter wrist pitch angle, press "Continue 

Enter wrist yaw angle, press "Continue' 

Enter hand roll angle, press '‘Continue" 

Enter Attach pt. to shoulder pitch 
.ength in ft. and press "Continue" 

Enter Sh. pitch to El. pitch length 
In ft. and press "Continue" 

Enter El. pitch to wrist piu.li length 
In ft. and press "Continue" 

Enter wrist pt. to wrist yaw length 
In ft. and press "continue" 

Enter wrist yaw to E.E. tip length 
in ft. and press "Continue" 

No Resp. Req. info only 

No Resp. Req. info only 

Enter 1 or 0 as desired, press "Continue" 
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H.P.-9825 Display 

OIsd. Duration 
Secs 

Response Required From User 

(17) Print Transf-Beam 2 
to Orb Sys? 

2 

No Resp. Req. Info, only 

(18) 1 ■ Yes 0 * No 

2 

No Resp. Req. info, only 

(19) 122 

m 

Enter 1 or 0 as desired, press "Continue 

(20) Print Transf-Beam 3 
to Orb Sys? 

2 

No Resp. Req. Info, only 

(21) 1 « Yes 0 ■ No 

2 

No Resp. Req. Info, only 

(22) Y22 

m 

Enter 1 or 0, press "Continue" 

(23) Print Transf-Beam 4 
to Orb Sys? 

2 

No Resp. Req. Info, only 

(24) 1 * Yes 0 * No 

2 

No Resp. Req. info, only 

(25) 1*22 

- 

Enter 1 or 0, press "Continue" 

(26) Print Transf-Beam 5 
to Orb Sys? 

2 

No Resp. Req. info, only 

(27) 1 ■ Yes 0 * No 

2 

No Resp. Req. Info, only 

(28) "*22 

• 

Enter 1 or 0, press "Continue" 

(29) Use Built-In flex 
coefficients? 

2 

No Resp. Req. Info, only 

(30) 1 * Yes 0 * No 

2 

No Resp. Req. Info, only 

(31) "Y22 

mm 

Enter 1 or 0, Press "Continue" 

If the answer is no, l.e. 

, 0 Entry in (31), Display will start from (32), 

otherwise from (40). 



(32) Input flex. 

coeff icients-Gammas 

2 

No Resp. Req. info, only 

(33) Z [1,1] 

- 

Enter Gamma 1 for Beam 1, 
press "Continue" 

(34) Z [2,2] 

> 

Enter Gamma 2 for Beam 1, 


press "Continue" 
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H.P.-9825 i'i ,'l ly 


Di.p. Duration Response Req uired From User 
mR 

(35) Z [3,3] - Enter Gamma 3 for Beam 1, 

press "Cont Inue" 

(36) Z [5,5] - Enter Gamma 4 for Beam 1, 

press “Continue" 

(37) Z [6,6] - Enter Gamna 5 for Beam 1, 

press "Continue" 

(38) 7 [2,6] - Enter Gamma 6 for Beam 1, 

press "Cont inue" 

(39) Z [3,5] - Enter Gamma 7 for Beam 1, 

press "Continue" 

Display will repeat from (3?) to (39) until flexibility coefficients for all 
the f ive beams have been entered 


(40) Pr’nt End-Effector 
arm flex. 7 

2 

No Resp. Reg. 

info. 

only 

(41 ) 1 ■ Yes 0 ■ No 

2 

No Resp. Req. 

info. 

only 

(4?) Y22 

- 

Enter 1 or 0, 

prets 

"Continue" 

(43) Print the Jacobian 
matrix? 

o 

C 

No Resp. Req. 

info. 

only 

(44) 1 • Yes 0 • No 

2 

No Resp. Req. 

info. 

on 1 y 

(45) Y?? 

- 

Enter 1 or 0, 

press 

"Cont inue" 

(46) Print joint flex, 
matrix? 

2 

No Resp. Req. 

info. 

only 

(47) 1 ■ Yes 0 » No 

2 

No Resp. Req. 

info. 

only 

(43) Y?2 

- 

Enter 1 or 0. 

press 

"Cont inue" 


End of the program 
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PROGRAM OUTPUT DESCRIPTION 


Output obtained depends upon the user's choke. The following data (except 
the components of beam lengths in the wrist-pitch system and the joint 
flexibility terms for the torque motor model which is always printed) is 
optional and can be printed or not printed. 

(i) Transformation matrices - from beam coordinate systems to orbiter 
system. 

(ii) End-Effector arm flexibility in W-pitch system i.e., if 

jfiej is a 6x1 deflection matrix at the E.E. due to j P e } loads at the 
E.E. then |^e| ■ {t|{P e }. And Jy| is the 6x6 E.E. flexibility matrix. 

(iii) Jacobian 6x6 matrix for the given arm configuration 

( tv ) Joint flexibility matrix. For a six joint system, six rotations 

(one rotation at each joint) can be related to torques at each Joint 
thru joint flexibility matrix. 

1«0| - | Yjj Jt F |, J Yj j - Jt. Flex. Matrix. 
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APPENDIX C 


C.l 


Example 1 

Calculate the flexibility coefficients of an arm composed of five beams with 
the following number of segments, section and material properties. 


Beam 1 

Number of segments • 3 



Segment 1 

Length (IN) 

1.0 

Youngs Modulus 
E (PSI) 

1.0 x 10 7 

Shear Modulus 
G (PSI) 

3.84615 x 10 6 

Moment of 
Inertia, First 
Cross Axis (IN'*) 

1.05 

Second Cross 
Axis (IN 4 ) 

2.04 

Polar Moment 
of Inertia (IN ) 

10.55 


Segment 2 

Segment 3 

16.0 

17.0 

1.0 x 10 7 

1.0 x 10 7 

3.84615 x 10 6 

3.84615 x 10 6 

6.8 

30.6 

6.8 

30.6 

400.00 

63.00 
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Number of Segments • 3 



Segment 1 

Segment 2 

Segment 3 

Length (IN) 

15.0 

235.0 

15.0 

Younq's Modulus 
(PSI) 

1.0 x 10 7 

2.22 x 10 7 

1.0 x 10 7 

Shear Modulus 
(PSI) 

3.84615 x 10 6 

5.63 x 10 6 

3.84615 x 

Moment of Inertia 
First Cross Axis 
(IN 4 ) 

27.0 

98.5 

27.0 

Second Cross Axis 
(IN 4 ) 

27.0 

98.5 

27.0 

Polar Moment 
of Inertia ( IN 4 ) 

55.6 

197.0 

55.6 

Beam 3 . 

• 

• 


Number of Segments 

- 3 




Segment ! 

Segment 2 

Segment 3 

Length (IN) 

15.0 

235.0 

15.0 

Young's Modulus 
(PSI) 

1.0 x 10 7 

2.22 x 10 7 

1.0 x 10 7 

Shear Modulus 
(PSI) 

3.84615 x 10 6 

5.63 x 10 6 

3.84615 x 

Moment of Inertia 
First Cross Axis 
(IN 4 ) 

27.0 

37.4 

12.0 

Moment of Inertia 
Second Cross Axis 
(IN 4 ) 

27.0 

37.4 

2.8 

Polar Moment of 
Inertia (IN 4 ) 

55.6 

74.8 

124.5 



Beam 4 


Number of Segments ■ 2 



Segment 1 


Segment 2 


Length (IN) 

15.0 


10.0 


Younq's Modulus 
(PS1) 

• 

o 

X 

o 


1.0 x 10 7 


Shear Modulus 

(psi) 

3.84615 x 

10 6 

3.84615 x 10 6 


Moment of Inertia 
First Cross Axis 
(IN 4 ) 

12.0 


1.868 


Second Cross Axis 
(IN 4 ) 

2.8 


8.0 


Polar Moment of 
Inertia (IN 4 ) 

124.5 


83.0 


Beam 5 





Number of Segments 

- 3 





Segment 1 


Segment 2 

Segment 3 

Length (IN) 

10.0 


20.0 

15.0 

Younq's Modulus 
(PSI) 

1.0 x 10 7 


1.0 x 10 7 

1.0 x 10 7 

Shear Modulus(PSI) 

3.84615 x 

10 6 

3.84615 x 10 6 

3.84615 x 10 6 

Moment of Inertia 
First Cross Axis 
(IN 4 ) 

1.868 


50.0 

1000.0 

Moment of Inertia 
Second Cross Axis 
(IN 4 ) 

8.0 


50.0 

1000.0 

Polar Moment of 

83.0 


100.0 

2000.0 


Inertia (IN 4 ) 
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Output from Program 'A 1 


ATTACH FT. ro SHOO LOCK MTCll»JCAM liO. ONC 
SHOO LUCK HliV'il 10 CL. I* t TCd'OEAM NO. TIM 
KLHOW If ITCH fO HAICT PITCH MAtt HO. nines 
WHIST Kirc.l TO WHIST YAW ill YM NO. FOUR 


HKiSr YAW 

ro L.tO CFFCCl'OK JCA.l NO. Five 
• 

FOR OCAM 

• 

NO ■ l--4ArRlX L | 2X2] l r |2X2| 

Lll.ll ■ 

1. OOJOOOe 00 

Lll.il • 

3. 4000000 01 

L|2,l| - 

o. ooooooe oo 

H2.2I - 

l. ooooooe oo 

r 1 1,11 - 

9. 54 505ie-06 

r 1 1 .2| - 

«>. 021257C-0S 

U2.ll - 

3. db047Je-07 

t 1 2 ,2 1 - 

3. 50 14 3 3C-06 

tor ac ah 

NO « 1— MATRIX L|2X2U ti2X2| 

Lll.ll • 

1. 000000C 00 

Lll.21 - 

j. ■* oooooe oi 

L|2,l| - 

o. ooooooe oo 

L 1 2 ,2 1 - 

l. ooooooe oo 

rll,l| • 

7. 996 7 32 C- 06 

1 1 1 .21 • 

5. 94422 7 e-05 

cl2.ll - 

3. 393o93K-07 

r 12 ,2| - 

3. 553J24S-06 

3 CAM WO. 

- 1 r'LCXl 0 1 LI I’Y COEr’F. 

CAMAY | 1 1 

■ 1. 2 62 44 le-06 rad/ft-lb 

GAMMA (2 j 

- 4 . 6 3 3053C -06 rad/ft-lb 

CAMAY | }| 

■ 4. 078431S-06 rad/ft-lb 

GAM /A l 4 1 

■ - 1 . 770339e-05 ft/ lb 

CAMAY l 5| 

- -2. 202660C-05 It/ lb 

CA IMA (II 

- -9. 54 50 5 le-06 ra-J/ lb 

GAMMA l 7) 

- -7. 996 7 320-06 rad/ lb 

FOR B CAM 

NO ■ 2— MATRIX L 12X21 i r (2X21 

Lll.ll - 

1 . ooooooe oo 

L|l,2| - 

2. C5J000S 02 

L|2,l| - 

o. ooooooe oo 

L12.2I - 

l. ooooooe oo 

rll,l| - 

2. 0)6 1 72 e-05 

r 1 1.2| - 

1 . to04o'j7e-0J 

c (2,1| ■ 

2. lJ5790e-07 

r 12 ,2| - 

2 . 396172e-0S 

FOR dKAM 

no » 2— matrix l 12x2] 4, t [ 2 .< 2 1 

Lll.ll ■ 

1 . ooooooe 00 

L 1 1 , 2 1 - 

2. 650000e 02 

L|2,l| - 

0 . ooooooe 00 

L12.2I - 

1 . ooooooe 00 

t 1 l , 1 1 ' 

2. 3 961 72 e-05 

c ( 1,2| - 

1. 604ti57e-0 1 

c 12 . II ■ 

2. 16-)790C-07 

c 12 ,2| • 

2. 39ol72e-05 

BEAM *nj. 

. 2 FLEXIBILITY COEFF. 

GAMMA 1 11 

■ 4.22u03ie-0u cad/ft-lb 1 

GA V IA l 2 I 

- 2. to2 2 94Ue - 06 rad/ft-lb 

CAMAY l J| 

2. 622 943C-06 raJ/ft-lb 

CAMAY (4) 

- -5. 0 i J 4 96C -04 It/ li? 

CAMAY | 51 

- -5. 0‘jJ4‘<de-04 £t/lb 

GAMMA M 

■ -2. J9to l 72r. -*)b r.)M/lb 

CAMAY l 7 1 

■ -2. U9o 172C-05 r.ul/ lb 


. ck'.INAU PACE 13 
, rcxm QUAUEfl 
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original PAGE b 

OE UOOR QUALITY, 


( 

< 

f 

( 

< 


rOK BEAM NO ■ 3--1ATKIX Ll2X2|fc r (2X2) F JR 3C..01.4C AXIS*! 

L|i,it • l. ooooooe oo 

L ( 1.2| - 2. 6500008 02 

L 1 2 . 1 1 - 0. 0000008 00 

L |2 .21 - 1.0000008 00 

III, II - 5. 2 745468-05 

III, 2| - 4. 01112 20-0) 

t 12,11 - 4. 6)59260-07 

I 12,21 - 7. OlOtobJO-OS 

FOR OCA. I t*0 • J— 4Ar*lX L | 2X2 1 l i (2X2) FOR 8CNDINC AXIS-2 
L 1,1| - 1. 0000000 00 

L 1,2| - 2. 6 5 0 0 0 0 r; 02 

L 2.1| - 0. 0000008 00 

L 2.2( > 1. 0000000 00 

I 1,11 - 5. 5325328-05 

I 1 .2| • • 4. 797 3 1 38-0 3 

t 2,1| - 8. 74 305 )0-07 

I 2,21 • 1. 7506558-04 

i) CAM MO. • 3 FLEXIBILITY COEFF. 

5AM.4AIH » 7. 913)968-06 rad/ft-lb 

SAM.4A ( 2 1 - 5. 50 31118 -06 tad/ft-lb 

CAM.MA | 3| - 1 . 0 4 9 1 6 38 - 0 5 rad/ft-lb 

CA.U\14) - -8. 3304428-04 ft/ lb 
CA,4i'k\ 1 5| • -8. 304 7728-04 ft/ lb 
8A.4.1A ( 6) - -5. 2 74 54 68-05 rad/lb 
GA.4J4A ( 7 ) - -5. 5025028-05 rad/ lb 


( 

f 


c 

K 

t 

v 

( 


t 


( 


FOR BEAM 
H 1,11 - 
L| 1,21 - 
L|2,l| - 
L 1 2 .2| - 
til, II - 
til, 21 - 
r (2 ,1| - 
r 12 ,2| - 


NO - 1--.4ATRI X 
1. 0000008 00 
2. 5000008 01 
0.0000008 00 
1.0000008 00 
4. 3o4 1608-06 

0. 3134598-05 
6. 6033198-07 

1. 1644 148-05 


UK BEAM NO 


4— 4ATR1X 


L | 2X2] l I |2X2| FOR 3E.JOt.4C AXIS-1 


L(2X2|l t 1 2X2 ) FOR BENDING AXIS-2 


L( 1,2| - 
L|2.1| - 
L|2,2| - 
til, II - 
ill, 21 - 
1 12 , 1 | - 
r 12 ,2| - 
JEA4 .40. 


1. 0000008 00 
2. 5000008 01 
0. 0000008 00 
1. 0000008 00 
1. 0000008-05 
7. 1726198-05 
6. 5071438-07 
6. 5173578-06 

- 4 FLEXIBILITY COEFF. 


CAri. lA 1 1 1 - 
3A.I.4A | 2 1 « 

OA.l.tN |3| - 
CA. I.U ( 4 | • 

CA.tMA ( 5| - 

CAM.tA ( G | « 

C.\.4.l\ | 7 1 - 


7. 51.10308-07 cad/ft-lb 
7. 92 393 38-06 rad/ft-lb 
7. 92 35715 -Ou rad/ft-lb 
-1.4356158-05 ft/ lb 
-4. 3724508-06 ft/ lb 
-4. 3o4 1608 -Oo rad/ lb 
-1. 0000008-05 tad/ lb 
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rott iu:\a 

NO • 5--4Af»UX M2X2|t *12X2) 

t'OA 

OU.iDIhG AXIS«1 

kll.il • 

1. OJOOOOC 00 



<•ii.il • 

4. aOOOOOC 01 



M2,l| - 

o.ooooooe oo 

1 


<•12.21 - 

1.000000C 00 



111. 11 • 

2. 2424530-05 


• 

*11.21 • 

1.21*6570-04 



*12,11 • 

a. 7ujJl)C-07 



*12.21 • 

3. 5 32 >100-00 



FO.t UCA1 

NO • 5--lAr*lX L (2X2) k * |2X21 

('OR 

OENOINO AXIS-2 

Lll.ll • 

l. ooooooe oo 



M1.2| • 

4. 5000001 01 



M2.il • 

o.ooooooe 00 



M2, 21 • 

l. ooooooe oo 


• 

*11.11 - 

6. 0 112 500-06 


• 

*11,21 ■ 

4. 3013 75C-OS 



*12,11 - 

1. 66S000C-07 


• 

*12,21 - 

1. 4312500-00 



OCA. 4 NO. 

• 5 rL.CXI.1K.lTY COE fK. 



O.VHAI 1| 

■ 1. 02 3305C-0u raJ/£t-lb 


• 

C.Vt l\|2| 

• 6. 92 193 3C -06 rad/ft-lb 


• 

JA.tl.M3) 

- 1. 993000C-C6 rad/ft-lb 



OA.1.IA 1 41 

• -1. 3957290-05 ft/ lb 


• 

uA.t. l\ 1 5| 

- -7. 3953170-05 £t/lb 



GAM-U (6) 

• -2. 2 42 4533-05 ta.l/lb 



0 A? U 17) 

• -ti. 0112500-00 rad/ lb 








t 




» 


I 




I 


I 








I 

t • 




* . 



\ 
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C.2 Example 2 

Calculate end effector arm flexibility in the wrist-pitch system for a five 
beam arm defined by the following beam lengths and orientation. Use the 
built-in flex ib< 1 ity coefficients for each beam. 


Outboard Roll Angle 

- 19.2* 

Shoulder Yaw Angle 

- 0.0* 

Shoulder Pitch Angle 

• 90.0* 

Elbow Pitch Angle 

■ -30.0° 

Wrist Pitch Angle 

- 30.0° 

Wrist Yaw Angle 

- 0.0“ 

Hand Roll Angle 

a 

o 

• 

o 

• 

Beam 1 Length, FT 

- 2.874033 

Beam 2 Length, FT 

« 20.920833 

Beam 3 Length, FT 

« 23.1625 

Beam 4 Length, FT 

- 1.5 

Beam 5 Length, FT 

« 4.416667 
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Output From Program ft 

The following output is obtained by answering "Yes" to all the print options 
available. 

OITJOAIU) ROLL ArtCl t*iO 
SnJOcJtH YAW .ViOLE-fl 
SHOULDER PITCH AoCLE - f 2 
ELHO.. PITCH A:.SLE*r ) 

wrist pitch A..ate>(« 

WRIST YA.7 A.<CL8*rS 
HARD ROLL Ai.OLEm6 - 

ATTACH PT. TO SHOULDER PITCH Lf.CTH-r7 

shoulder pitch ru tuow pitch length* i8 

ELJO./ PITCH TO HR 1ST PITCH UMOTH-’r* 

WRIST PITCH TO HA I ST YAH LK.sCTH*rlO 
WRIST YAW TO ti«0 Ct FCC TOM Lt..Gra»ril 


TRANSFORMATION FROM BEAM ONE, SYSTEM TO ORJlTEH SYSTEM 
0. OOOOOU8 00 0.0000006 00 1. OJOuOOC 00 


-3. 2886668-01 

9. 4437648-01 

0. 0000008 00 
• 

-9. 44 J7648-01 

-3. 2886668-01 

0.0000008 00 

TRAM "MltATIOU 
0.0 •>.-.* 00 

PROM BEAM TWO TO ORA ITER SYSTEM 
0. 000 0000 00 - 1. 0000008 00 

-3.2886668-01 

-9. 4437648-01 

0. 0000008 00 

>9. 4437648-01 

3. 2886668-01 

0. 0000008 00 

If RA HSFORMAT I OH 
-5. 00000 Jo -01 

FROM SEAM THREE SYSTEM TO OR3ITER SYSTEM 
0.0000008 00 -3. 6602S4E-01 

-2. 8480698-01 

-9. 44:7648-01 

1. 6443338-01 

”8. 1786390-01 

3.2886668-01 

4. 7218828-01 

TRA4SPOR.tATIO.-4 
0.0000000 00 

FROM Mr. AM FOJR SYSTEM TO ORJITEH SYSTEM 
0.0000008 00 -1.0000008 00 

-3. 2386668-01 

-9. 4437648-01 

1. 0000008-12 

-9. 4437648-01 

3.2886668-01 

0. OOOOOOE 00 

TRA.4SPOH lATlOfl 
0.0000008 00 

FROM REAM FIVE SYSTK 
0.0000008 00 

I TO OR:! ITER SYSTEM 
-l. 0000008 00 

••3. 2386668-01 

-9. 44376 48-01 

1. 0000008-12 

-9. 44)76 10-Cl 

3. 2006668-01 

0. 0000008 00 
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CALCULATE CO.VONLI.fi OF LENGTH VECTORS 1.4 THE LVlSf-.'IfOH SYSTEM 


co vo. c.ri or »t am r>n length in r.<c whi t-piich system 
i. o‘ti jol oi -i.o* ijiiL-n U4t-w 


CO IPJNtwTS or BEAM three length in the waist-pitch system 
i. oossm oi i.juisoi-n i. mim oi 


components or beam tour length in the whist-pitch system 

1. 4000J0E 00 0.0000002 00 0. OJOOOCC 00 


components or beam rive length in the waist-pitch system 

4. 4166672 00 i.JDHU-ll 0. OOOOOOE 00 


cno ErrccroH , 
1. 4 4J7002-04 
I. 0 142412-1 7 
l. 0142 402-06 
-1. 4710412-la 
-S. 40714 1 E-OS 
4. 12 1 7J42-16 


I FLEXIBILITY I 
2.0142442-17 

2. 70 700J.:-os 
-4. 00940 IE -14 
1. 0 444 412-04 
•1. 1050912-16 
-4. 4416152-04 


THE WHIST-PIT' 
1.0l 32502-0a 
-B. 0O9401E-16 
2. 41 4 7002-05 
•2. 4 392 932-la 
4. n9» >040-04 
2. u 144c42-la 


SYSTEM 

-1. 4710412-14 
L II ISIU-M 
-2.9' 2912-14 
1. • t IB JE-OJ 
-7. 12 92 742-15 
9679462-03 


-S. 407141E-04 
1 1 . - 1 » 
4. 6 999742-04 
-7. 12 72 742-14 
1. 76 4 1 4 1 E - 02 
1. 47J612E-14 


4. 12 17062-14 
-4. 43J415C-04 

5. C19UM*1« 

-I. 94 79162-01 

1. 47J612E-14 
1. 444244E-02 


JACOBIAN TOR 
l. OOOOOOE 00 
•1. OOOOOOE- 12 
- J. 2 S4»*4E- 1 1 
-1. 1441242-11 
-1. 14412 it 01 
4. 7 9 71 J IE- 1 1 


S A 1C 4 COST. IN 
-1. OOOJOCE-12 
1. OOOOOOE 00 
44J 74 4E-1J 
L 15S1252 01 
-J. 2 70697E-U 
-4. o 0 9a B IE 01 


THE WRIST-PITCH 
2. OOOOOOE- 12 
1. OOOOOOE 00 
- 7. S 1 S09 7E - 14 
1. 1 SB 12 42 01 
-2. 4197742-11 
-2. 4974742 01 


SY3TEM 

0. 000000E 00 

1. OOOOOOE 00 
0. OOOOOOE 00 
0. OOOOOOE 00 
0. OOOOOOE 00 

•4. 916ou7C 00 


0. OOOOOOE 00 

0. 000000E 00 

1. OOOOOOE 00 
-4.44JJJ4E-12 

4. 4 lto4 72 00 
0. OOOOOOE 00 


1. OOOOOOE 00 
2. OOOOOOE- 12 
0. OOOOOOE 00 
0. OOOOOOE 00 
0. OOOOOOE 00 
0. OOOOOOE 00 


JOINT PLEAI 3 I LITY MATRIX 
1. 0 4 74 >42 -04 o. Mf 7>12-17 

4. 9947442-17 6. 1941012-04 


J. S 41)442-17 
1. 77974 72-16 
-2 . 9 4 0 4412-04 
-9. 7140122-04 


- 3. 02 72942-07 

- 1 . 70 2 J 422 - 07 
-2. 9736422-17 
-6. l>oa 992 -1 7 


3. 6 )1 3682-17 
-1.02 72 )42-0 7 
2. 4J9004S-04 

1. 2 2 7 d 402 -06 

2. 71 49942- IS 
-4. 7017792-17 


1. 779747S-16 
-1. 7020422-07 
1. 22 73 401-0# 
l. 71 Oj 002 -0 4 
-a. 693 7012-17 
-1. 6240142-la 


-2.940JS1E-0S 
-2. 9746422-17 
2.71 : 4 

-6. 691 70 32-17 
2. SJ 4 7007-04 
1. 06 190 1>2 -0 4 


-9. 71 4012C-04 
-6. 14.69)2-17 
-4. 74177 )i -17 
- 1. 6240142-16 

4. 0019062-04 
1. 0404142-04 


JOINT FLEXIBILITIES (OR THE TCKJUE MJTOR MODEL 


SHOULDER 

SHOULDER 

ELBOW 

WRIST 

cvet 

HAND 

YAH J T. 

PITCH J r. 

PITCH JT. 

PITCH JT. 

YAW JT. 

MOLL 

1. 49672-04 

6. 147:e-wJ 

2.44442-06 

1. 64402-04 

1. 40442-04 

1. 14142-04 
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C.3 Comparison of Results 


C.3.1 Flexibility Coefficients - Program 'A* 


Beam 

Flexibility Coefficients 

Flexibility Coefficients Used 

Number 

Calculated by Program 'A' 

In the PDRSS, Calculated by IEC 


GAMMA (1) • 4.226034 x 10 ' 6 

4.24 x 10‘ 6 


GAMMA (2) - 2.622948 x 10‘ 6 

2.616 x 10- 6 


GAMMA (3) • 2.622948 x 10' 6 

2.628 x 10" 6 

2 

GAMMA (4) » 5.058498 x 10 -4 

5.0585 x 10- 4 


GAMMA (5) - 5.058498 x 10“ 4 

5.0585 x 10- 4 


GAMMA (6) » -2.896172 x 10’ 5 

-2.895 x 10" 5 


GAMMA (7) - 2.896172 x 10’ 5 

2.896 x 10- 5 


GAMMA (1) - 7.913996 x 10 -6 

7.908 x 10‘ 6 


GAMMA (2) « 5.563111 x 10” 6 

5.568 x 10- 6 


GAMMA (3) • 1.049168 x 10“ 5 

1.0438 x lO- 5 

3 

GAMMA (4) - 8.330442 x 10’ 4 

8.3304 x 10' 4 


GAMMA (5) - 8.304772 x 10 -4 

8.3048 x 10’ 4 


GAMMA (6) » 5.274546 x 10' 5 

5.274 x 10‘ 5 


GAMMA (7) - -5.582582 x IQ‘5 

-5.583 x 10- 5 


C-10 


C.3.2 End-Effector Flexibility, Program * 8 * 


End-Effector Flexibility Calculated by Program * B ' 


1.4&8700 x 10 5 

0.0 

1.013250 x 

10* 6 

0.0 

-8.407181 x IO* 5 

0.0 


0.0 

2.707000 x IO* 5 

0.0 


1.054631 x !0‘ 4 

0.0 

-4.533615 

x IO* 4 

1. 01325 J X IO’ 6 

0.0 

2.825700 x 

lO- 6 

0.0 ' 

4.699904 x 10 ^ 

0.0 


. 0 

1.05-1631 x 10* 4 

0.0 


1.106363 x 10° 

0.0 

-3.967946 

x IO* 3 

-8.407181 x 10- 5 

0.0 

4.699904 x 

io * 4 

0.0 

1.765481 x 10' ? 

0.0 


0.0 

-4.583615 x 10- 

0.0 


-3.967946 x IO' 3 

0.0 

1.545254 x 

: IO* 2 

End-Effector flexibility Calculated 

by PDRSS 






1.458700 x 10* 5 

0.0 

1.013249 x 

10 * 6 

0.0 

-8.407181 x IO’ 5 

0.0 


0.0 

2.707000 x 10* 5 

0.0 


1.054631 x IO* 5 

0.0 

-4.533615 

x IO* 4 

1.013249 x in- 6 

0.0 

2.825700 ; 

IO* 6 

0.0 

4.699903 x IO* 4 

0.0 


0.0 

1.054631 x 10- 5 

0.0 


1.106363 x IO* 3 

0.0 

-3.967945 

x IO' 3 

-8.407181 x 10- 5 

0.0 

4.699903 x 

io - 4 

0.0 

1.765480 x 10-2 

0.0 


0.0 

-4.583615 x IQ’ 4 

0.0 


-3.967945 x IO* 3 

0.0 

1.545253 x 

IO’ 2 


c-n 


APPENDIX D 


D.l listing of Program A 


Oi (It 6 
I fmt l,cl3. 6,z 
1 1 fmt 2 , fl. 0,c22 * 

3i fat 3,1/ 

4: fmt 4, (1. 0,c4 1,(1. 0 
5: fmt 5, cl 3. 6 

6s wrt 6 , "ATTACH FT. TO SilOULDER PITCH-SEAM NO. ONE* 
7: wrt 6 , "SHJJLuER PITCH To CL. PITCH* JJV1 NO. TWO* 
3: wrt 6 , FITCH 10 WAIST PIYC.i*JE.Yl NO. THREE* 

9: wrt 6, M ..KtaT FITCH TO WHIST YAW-JEAM NO. FOJk" 


I . •" l 


, I 


10 

11 

12 

13 

14 

15 

16 
17 
Id 
ID 
20 
21 
22 

23 

24 

25 

26 
27 
2d 

29 

30 

31 

32 

33 

34 

35 

36 

37 
3d 

39 

40 

41 

42 

43 

44 

45 

46 

47 
43 

49 

50 

51 

52 

53 

54 

55 

56 

57 
50 

59 

60 
61 
62 
63 


wrt 6,"..«\IS'f YAW TO ENli fcr FECYOR«3 EAi 4 NO. FIVE* 
wrt 6.3 

dim L| 50 | ,E [ 50) ,1 ( S0| ,G| 50} ,J(50) 

dim A| 2,21 ,W |2,2 | ,J(2,2| ,C | 2,2| ,0 |2, 2| ,F [2 ,2 } ,H 1 2 ,2 } ,M [2 ,2 ] 
dim PJ 7| 

dsp " JEA.t ONE, FIRST CROSS AXI3";wait 2000 
l*r0 

onp "WO. OF SEGMEN TS" ,S 

1*0 ’ . . 

1*K 

dsp “NOTATION USED FOR SEGMENT K*jwait 2000 
d so *L(K) - LENGTH, INCHES" jwait 2000 
dsD " E I K 1 - YOJNGS MOO., P5I"jwait 2000 
deo "G(KJ - SHEAR MOO., Pal " » wa i t 2 000 
dsp “ I (rx) *.10. IE. IT OF INER. ,(I«) *4“ jwait 2000 
d so "J |K| -POLAR MOrfT. INER. ,(Iri) *4* {wait 2000 
cnp L (K) , E | K) ,S[K] , I IK) , J ( K | 
if K<3 ;N+'l*i<;qto 26 
1 *A ( 1 , 1 1 *A 1 2 ,2 1 
L[1|*A(1,2| 

0*A(2,1| 

0. Nil, il * N ( 1 , 2 ] « N ( 2 ,1] * N ( 2 , 2 1 
1*K 

L(K)L[K)/2E(K]I(K|*Q(1,1J*3(2,2J 
L(X|L(K)L[K)/o0(X)l ( K) *3 ( 1,2 1 
L(K1/E C<) I | K | ♦ 3 1 2 , 1 ) 
if <C<S ; K* 1*< i q '.o 3d 
qto 51 

1*C (1,11 *C (2,2| 

L|K| C ( 1,2| - 

0 *C ( 2 , 1 1 

L(KjL[K|/2E(K|I ( K| • D ( 1 , 1 ) *U|2, 2 | 

L|K|L(K] L(K|/6E K] I ( K1 0(1,2] 

L l X ) /£ (XJ 1 (KJ *0(2 ,1 | 
mat CA*F 
mat C3*H 
mat OA»M 
ara HM*H 
ara F* A 
ara 11*3 
qto 36 

wrt 6. 4, "FOR 3EAM NO * ",r0,* 


^ C£0,NG PA « BUNK NOT FILMfct. 


wrt 6. 5, "L(l,l| - *,A( 1,1) 
wrt 6. 5, " L ( 1 , 2 ) - ",A(1,2| 
wrt 6. 5, "L(2,I| * " , A ( 2 ,1) 
wrt 6 . 5 , " L ( 2 , 2 ) - *,A(2,2] 
wrt 6. 5, “r (1,1) - ", U|l, 1| 
wrt 6. 5, "r (1,2 | - ",u(l,2| 
wrt 6. 5, "r |2,l| * ", 3|2,l| 
wrt 6. 5,"rl2,2|. « ",u|2,2| 
if O>l;qto 70 
123(2,1] »P|2| 

(d 1 1 , 2 1 - 3 i 1 , 1 1 A 1 1,2 ) 1 /12 *l* ( 5J 
3(2, 2|-3(2, 1 1 A ( l , 2| • l’(0| 


1ATRIX L(2X2(t r (2X2 ) FOR SENOIWG AXIS->*,0 
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b«t 0*l«0 

6b; dtp “.10. ltd r OF INCH. -2<4i> CiIJ.it. AXI„*;wait 2000 
66 1 l'K 
6 7; cno 1 1 K| 

66; i t KxS j K ♦ 1 ».<;<) to 67 ! » 

69; qto 26 • • * 

70; 12JI2.1I • ** | J 1 
71; (6 1 1 ,2 1 - J|1,1|A|1,2) )/12 »F|4) 

72; J|2,2|-d |2,1| AU.2] .P17| 

72; 1.6 

74; 121. |K1/J|K|J |K|. I'll) 1 
7b; if K<S ; K* 1 «K ;qtO 77 • 

76 1 qto 76 • * 

77; 12L|K|/0|KU |K1«P|11 .KlllntO 75 
76; w;t 6.2, 

79; wrt 6.1. 

60: w ; t 6. 1 , 

61: wrt 6. 1 , 

62: wit o.l, 

63; w r t 6. 1 , 

64: wrt 6.1, 

65: wrt 6. 1 , 
do: w r t 6. 3 
87: if rO<bj r0»l«r0j.jto 89 
66; qto 93 

89: if r0*2;dsp "BEAM r. JO, FIRST CROSS AXlS*;wait 2 000;qto 17 
90; if t0* 3 ; Jsp *3EAM T;1H£E .FIRST CROSS AXlS";walt 2 000;qlo 17 
91; if r0* 4 ; J ip "3EAM FOUR, FIRST CROSS AXI3"»wait 2000»]tO 17 
92; if r0* b) dsp “SEAM FIVE, FIRST CROSS AXlS";wait 2 000jjto 17 

nuw' 


REAM i)0. 

■ 

*. to,*— 

avuAUi 

• 

•.fill 

CiV4.l\ [2 1 

■ 

MMil ,* 

J| 

■ 

* # F | J| 

&\.l.w\ |4| 

■ 

*, t’14| ,* 

a\.t.i\ |5| 

• 

*. Plbl ,* 

CA.t.U (6| 

m 

■, 1 «• 1 

\ l 2) 

m 

" » F 1 7| 


r.id/ft-lb* 
rad/fl-lb* 
ft/ lb* 
ft/ lb* 
r ad/ lb* 
rad/ lb* 


! 
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P ,? Hst lug O f lYoijr.im B 


0| (It 9 

ll wit e , "OdMO.YKO 101.1. MCLtorO* 

2 1 wit o , IddLlh :k YAW AhOU:*rl’ 

3l wit u , mVil ANCUL<r( a 

4 1 wit u,"il.JOW A.*OLe I I* 

Si wit b , " lit PITCH AwCLC*i4* 

«*i wit b, tur YAW A.KU«U*(5 a 

II wit b • "iltwO UJL.L AibUl'ti' 

8 i wit o , "appaoii rr. ro sitojuitR pircti Leworn-ri* 

«i wit *, •.••.itooujt.t i* i t'Cii ro it. »o.< men uworw-tJ" 
to: wit b, "ii.no.. mv ii ro w.usr men tEwcr«i-i9 B 

Hi wit »,'.aur p i row ro witi:;r yaw Luword*iid" 

lit wit b,*»nisr yaw ro i:m> intvron ttworiWll* 

1 Jt hi 1,1/ 

14 I wit b. 1 

lbi Jia A| 3, 3|,J|3, J|,C|),3| , 0 | 3.1) ,C (3,31 ,r (3,3) , 3 ( 3 , 31 , 11 ( 3,11 
l»l d*.a 1|J, 11 .JIJ.ll.KlJ.ll.LlJ.ll ,11 J,ll ,Wlb,ol , i| 6 ,b|,Pl 6 ,*| 

1 >1 0 t a 0 1 u ( b | ,i< lb ,i> I , a | o ,b | , 1 1 b ,b| ,X l b ,b| ,Y l b ,b| , . |b,b | ,0 | 3, 1| 

III Win V t b , lu | , • 1 lb ,b 1 

1 0 (• p “IWi'Or AWut.tO AND Lt’Wliriti" jw.nl (000 

20i OmU 

1 1 1 o np i iU 

22 t l( 1 12 < 1 1 1 l»tl 2 *il 2 t<)to 21 

21: -l*dll,l| »0*UU,2| *U|1,31 *d|2,l) *U(3,1| 

2 4t -cosir 01 •0(2,2 | :co'. UO) »U| 3, 3) i a in(r0) *0 12,31 •0|1,21 
2M 0 • A 1 1 , 1 1 • A 1 1 , 2 | • A 1 2 , 1 1 • A | 3 , 3 1 

2 bi 1 • A 1 1 , 1 1 

Hi - • i n 1 1 0 1 • A 1 , l ) »Al 1,21 

20i coaltOl *A|2 ,2 | i con (tO) • A (3,11 

2»t All,l|. .1(1,11 t A 12 , !!• 412,11 |A| 3,l| *W( 3, 11 

. 10 1 (,nt 2 ,tll. 1 ,)«, i’ll. (<,&>,el ).«,!/ 

111 t.nt 3,i’ l 1. i> , lx, ol 3. 6 , lx, cl 3. b,3x, cl 1. 6 , h, el 3. 6 ,3 X, el 3. 6 

32 1 Os.? "Print rr.tnsC-O'.i.n 1 ro otl> Syii?">wail 2000 

111 o..p " l* YUS U*WO * jwalt 2000 

34 1 ent 1 22 

35i if t22*0;-)to 19 

1 i* : 1 • i ’ I 

i»i wit $,*rRANt;poR.t\rio .'4 t’lio.i sc a t one system ro oiuitcr system" 

r 23,3| | 3 (1* i2 3* [2 1) >1 

,11 *013,21 

11 

42 1 1*2 1 2 ,2 | | 0 *0 1 1 ,2 I *012,11 *012,1| ^2| 3,21 
4 3 1 coa(r2l *211,11 *0 ( 3,3| is in(r 2) *0| 3,1| i ~aln(r2 > «C t l,l| 

4 4 1 tin It* 0 
4Si trn C*tl 
46: Mat OB* P 
4 7i .it at ur*J 

4*1: d|l,*| *1(7,21 |0|2, 2) *W|0,21|C| 1,21 *W14, 21 
4‘): dap "Print fra oaf -to .vs 2 r.t Out Sya/*jwalt 2000 
5Jt dap " 1-YOS , 0 WO "iwall 2000 
Mi ent 1 2 2 

42 i it 1 2 .’ 0} >) to 5b 
S3: 1.(2 3 

44 1 wit b,*rnAn.si‘i)K.i,\ftos rno;i n i:\m r.«v> ro ounirt'R SYsrt:;t" 

54* wit U.2,0,|r2 3,11 ,3 lr 2 1,21 .0 1 r 2 3 , 1| 1 3 mp ( l ♦ t2 3*»2 3) >3 
So : co . (i I) *0 11,11 *0 l 3 , 3 1 j a inlr 3) *013, 1 1 j - a »n(i )| *0|1,3| 

57i ti 11 C*d 

50 1 ut.it o*:*i) 

59: Oll,2|.*4| 13,3| :0(2,2| *21 U,l| |Oll,2| *.l| 15,3| 
bO: dan ".’lint tt.tnat J.mi 3 iU Oca Sya?";watt 2000 
til: J.tp * l* Yds ,0*WO "jwjit 2000 
02 1 ent i 22 
b 3: l t (22 *0: (to t> 1 


3d i wit o. 2 ,A U2 1,1 1 ,\U 2 1,21 ,M 
}«>* 1*011.31 | 0 - *» 1 1, t| *i»!2 ,3| * M 3 
10: coalifi *1311,11 • .» 1 2 ,2 | 

41: a in(i li *il| 1 ,.’ | 1 . in (r 1) *il|7 , 


D-3 


, «* 4 * l*r2 3 

’ 65s wrt 6 , "TRANCFOR‘tVTIO.4 PROM U CAM rilPCl! SYSTEM TO ORJITER SYSTEM* 

to: wrt 0. 2 ,0 (r 2 J,l| , 0 |s 23,2) ,u|r 2 J,3|j ) mo (1* ri |*rl 3) >3 

( 6 7* coa(r 4) *C 1 1,1 1 *C | J.3| ;a in(r 4) <0 | 3,1 ) j - sinls 4| *C 1 1,3| 

o'J: trn C«f 
64 i .not DF*E 

7J i E 1 1 ,? | *8 | )9 , 4 | ; E (2 ,2 1 *1(20,41 : f. | 3 ,7 1 • 4 1 2 1 , 4 1 
v 71s dtp "Flint Transf-d^am 4 t'o Or o Sya?“jwait 2000 
72 s d;.p * 1 ■ YES ,0*.JO ";wait 2000 
( 73s ent r 2 ? 

' 74s it r22'0j<jto 78 

75s l*r2 3 

7os wrt 6 , " TRANSPOSE tATIOi* P ROM REAM POUR SYSTEM TO OR3ITER SYSTEM* 
v 7?s wrt 6.2,0|r23,l| ,E|s23,2] ,0(r23,3|i3flp (1» tl 3*r2 I) >3 
73s cos (r Si *dll,l|*d|2,2|sjin(r5) *U(l,2||-sin(r5)*d|2,l) 

( 79s trn d*P 

80s mat KP • U 

• 8ls F|l,3| *. 4)25, 5) |P|2,3| *8(26, 5| s F(3,l| *4)27,51 
r 82s 1*C|1 # 1|>0*C|1 # 2) C(l # J)«0(2 # i| *C(3,l| 

v Sis cot (to) «C (2 ,2 1 *C ( 3,3) ssin(r 6) *C|2,3|j-sin(r6) «C ( 3,2) * • . 

S4s trn C«F 

85s mat DP*C 

Sos C(l,l| • J| 31,61 ;C|2,\| ».4( 32 ,6) sC| 3,l| *4(33, 6| 

87s dso "Print Transf-dsam 5 To Oro Sys?"swait 2000 

• 83s d&p " 1-YCS ,0-.4O *» wait 2000 
89s cnt r22 

90s if r22*0;<] to 94 
. 91 s l*r2 3 

' 92s wrt 6, "TRANSFORMATION FROM BEAM FIVE SYSTEM TO ORJITER SYSTEM* 

93s wrt 6. 2 ,C | r 2 J,l| ,0 (r 2 3,2 1 ,C ( r 23,3) ; jmp (L»r2 3*r2 3)>3 
, 94 s inv A* A 

95s mat AE*B 

96s trn d*A 

97s All, 1 1 *.211,11 ; A 1 2 , 1|*4(2, 1) s A | 3 ,1 1 *4 ( 3 ,1 ) 
v 93: inv G«C 
99s mat GE*a 
. 100s trn d*3 

1 10 ) s G(l,2) ♦4(7,2) sG(2,2) *.4( 8 ,2 ) ; C[ 3,2) •»! (9,2) 

102s inv 0*D 

. 101s mat OS»a • 

104s trn d* i) 

105s D| 1,2| Ml 13, 3) |0 (2,2| v.4( 14, 3) | 0(3, 2 1 *8(15,3) 

, lOo: 0.,4[ 19,4| *.4(2l,4| ; 1*1(20, 4| 

' 10 7 s i nv E* F 

103s mat FC*B 
, 109s ara 0*C 

' HOs C|l,l] *.f ( 31,6| ;C|2,1) *W( 32 ,6) |C(1,1) *8(31,6) 

Ills idn E 

112 s wrt 6, "CALCULATE CO.VO.4Ei4 TS OF LE.4GTII VECTORS IN 1’IIE WRIST-PITCH SYSTEM 
v 113: wrt 6. 1 

114s r3 *.l 1 1 , 1 1 ; 0 *;i | 2 , l| *>1(3,1) 

, 115s mat C.I*I 

116s wrt 6 , "COMPONENTS OF BEAM TWO LENGTH IN THE WRIST-PITCH SYSTEM" 

117s wrt 6.2.1(1,1) , l (2,11 ,1(3,1) 

1 13 s r9 *.! 1 1 , 1 1 

‘ 119s mat 0H*J 

12 0s wr t 6. I 

12 Is wrt 6, "COMPONENTS OF JEAM THREE LENGTH IN THE WRIST-PITCH SYSTEM" 

122 s w-t 6. 2,J|1,1| ,J(2,1| ,J(3,l| 

123: rlu >111,1) 

12 4: mat EH*.< 

' 125s wrt 6. 1 

12a: wrt 6 , "COMPONENTS OF REAM FOUR LENGTH IN THE WRIST-PITCH SYSTEM" 

12 7: wrt 6. ’,R| 1,1) ..<(2.11 ,K| 3.1) 
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( 

r 


lid: 
12 9: 
1)0: 
in: 
llil 
133: 
1 31 
135 
1 Jo 
137 
13d 

139 

140 


f 11*111.11 
mat C.I*L 
wit 6. 1 

wit 6 , "COMPONENTS OF 3CAM KIVE LENGTH IN Tilt WRIST-PITCH SYSTEM* 
wit o. 2 , LI 1 . 1 1 . L ( 2 , 1) ,L ( 3 . 1| 

1* (1 3 

1( 1 1 3 > 1 ; t o 142 

aia K ♦ L • .4 • 

a i a JM*4 

at A 1M*.4 

•4 I 3 , 1 1 ♦ V 1 4 « 2 I • V 1 4 ,d | | -.1 1 3 , 1 1 *V ( 5 , 11 ♦ V| 5,7| — 

-.112.11 *V|4 # 31*V|4.91 1 1412,11 *V|6,1| *V|6,7| 

Ml 1.11 *V|S,3| -Vli.91i-.lll.il • V 1 6 ,2 1 *V 16,8| 


111 


n °,iv> 


>2 i o to 149 




143: 

a: a K»L*M 




• 

144: 

at a JM *.i 





145: 

M| Ml ♦ V 1 4 , 

14 1 j -M 1 3 

,11 

*v| 5, 

13| 

146: 

-.4|2,l| • V l 4 

,151 1 *>1 2 

,11 

•V [ 6, 

,135 

147: 

.411,11 ♦ V 1 5 , 

lal J-.1I1 

.1) 

•V l 6, 

.14) 

143: 

qtO 163 





149: 

if i!3>3:<}to 155 


• 


150: 

ata K*L*.4 





151: 

.•413,11 *V[4, 

2 01: -M| 3 

,11 

*V(5 

.191 

152: 

-4[2.1| ♦ V l 4 

, 2 1 1 ; 71 1 2 

.11 

♦ V l h ( 

,191 

153: 

Mil, 11 • V 1 5 , 

2 1 1: -M 1 1 

,11 

♦ V j 6 , 

,201 

154: 

.)to 163 





155: 

if 1 1 3 > 4 ; j t o 172 

. 




15o 


au L* : 4 


( 


» 


1S7: 
153: 
1 59: 
160: 
161: 
162: 
163: 
164: 

16 S: 
loo: 
167: 
163: 
169: 
170: 
171: 
172: 

17 J : 
174: 
175: 
1 7o : 
177: 
171: 
179: 
130: 
131: 
132: 
Id 3: 
Id 4 : 
133: 
106: 
137: 
1311: 
139: 
190: 
191: 


••U J , 1 1 * V ( 4 ,2 61 : -Ml 3 ,1 1 • V l 5 ,2 5| 

-.412,11 *7(4,2 7) } ,4 1 2,1 1 *V(6,2S| 

.411,11 • V 1 5 , 2 7 | : .-M 1 1 , 1 1 • V ( 6 , 2 o ) 

9 to 16 3 

l*.4ll,l| *11(2,21 *N[ 3,3 | *N | 4,41 *N( 3,51 *N [6,6| 
0*.* 1 1,2 1 *N|l,l|*N(l,41*wll,51 *1111,61 
0*.: 12,1| *.412,31 *N (2,41 *N l 2,5) *.112,6| 

0*N ( ) , 1 1 *N[3,2|*N[3,4|*N|3,5| *.4ll,6| 

0 * .« [ 4 , 1 1 *N l 4 ,5 | • N 1 4 , 6 1 

0 • N | 5 , 2 | *.41S,4| *9(5,6) 

0 • .1 1 o , 3 1 *.4(6,41 *.4|6,51 

M l 3 , 1| *ll (4 ,2 | : -.4[ 3,1) *N15,11 
-•412,1| *14(4,31 11412,11 *N16,1| 

Mil, 1| «N (5,3 1 } -It 1 1,1 1 * N | 6 ,2 | 

Imp 2 
idn N 
trn N * O 
l*rl4 
I*il5 

0*P|rl4,3*rl5) *P| 3>r 15, tl 4| 
if 1 1 S<3 : 1* 1 1 5 *r 1 5j. | to 176 
if r 14 < t ; HrL4 *rl4;.)to 175 
if 1 1 J> 1 ; 4 to 106 
l*rl4 

1 ♦ r 1 5 

Air 14,1151 *P|tl4,tl5| *r|l»rl4,3»rl5| 
if tl5<3| l*rl5*rl5,’<jto 132 
if til <3: l ♦ 1 1 i • 1 1 4 ; <] t o 131 
ijto 213 

if r 1 3>2 ; <j to 193 

l*tl 4 

l*tl5 

Clrlt,rl5| *P|t 14, i l 5| *P | 3* c l 1 , H rl5) 
if tl5<3;lKlS*tlS;|to 109 
if 1 1 4 < J ; l»rl 4 *cl4;:to 193 


« 


• 4 


% 


i 
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192 i ato 2 1 J 

193: if ; 1 3>3 jg to 200 

194: I*rl4 

19‘j: l«rl5 

196: D|rl4,rlS|*P|rl4 # rlS)*P|3trl4 ( 3»rlS) 

197; if cl><): l*dS*rlS;gto 196 
193: if 1 1 J < 3 ; 1 * : 1 4 • ; 1 ;gto 199 
199: gto 2 13 . , # 

200: if r 1 1>4 : g to 207 
201: 1 *(14 
202: ImIS 

2 03: E|rl4.rlS| .P|cl4,rl5| »P| 3*c 14 ,3» rl5| 

201: if ili<3j l*tlS«clSigto 203 

209: if tl4<3i I*il4 ««il4jgto 202 

206: gto 2 1 3 

207: if r!3>Sjgto 373 

203: l«rl4 

209: l»rlS 

210: C|cl4,rlS| *P|rl4.rl5| «P(3*rl4 ,3»rl5| 

211: if tl5<3: 1* 1 1 5*r 1 Sj g to 210 
212: if il4<J: 1* r 1 4 *rl 4;g to 209 
213: trn P* Q 
214: if rl 3>l>gto 213 

21S: dcp "Use Oailt-In Flex Coe £ f icicnta?" jwa i t 2000 
216: dsp "l * YCS.O *,«d" j wa : t 2000 
217; ent [22 

. I 

. 1 


» «• 

J 

• • 



\ 


t 

• 

I 

I 


i 
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2 1 d : i f r22*0;jto 244 
219: if ( 1 3 > l ; j to 224 

22 0: 1. 26c-i>* 4|1,1|;4. OUe- 6*2 ( 2, 2 | ; 4. 6 32 e- 6*2(3,31 

221: 3. 32*4o- 5 *215,51: 2. 3993c* 5*2 (6 ,6) » -3. 96 be- 6 *Z |2 ,6| » 1. 12e-S*Z|3,5| 

222: 2 (2 ,6| *2(6,2); 2 (3,5) *2(5, J| 

223: q to 2 48 

224: if r 1 3 >2 ;qto 229 

22 5: 4.2 4e-6*Z|l,ll;2.616c-6*Z|i,2); 2.623e-6*2|3,3); 5. 0535c- 4*Z (5,5) 

226: 5. 0S45o-4 *2(6, 6| > -2. 8 9 so- 5 *2 |2 ,6| j 2. 3;5e-5«Z(3,5) 

22 7: Z 1 2 ,u| * .’ | G ,2| ; 2 ( 3,5] *2 | 5,3) 

228: q to 253 

229: if rl3>3;gto 234 

2 30: 7. 903 0-6*2)1,11 j 1.04 38c- 5*212,2) j 5. 563e-6 *2 (3 ,3 ) : 8. 3048e- 4 *2 |5,5) 

2 31: 3. 3304O-4 *2|6,61 ; -5. 53 3a- 5 *Z 12 ,6) j 5. 2 74e- 5* 2 1 3,5) 

232: 2 )2 , 6| *2|6,2| )2[3,5|*Z|5, 3) 

233: q to 253 
2 34: if rl3>4;qto 239 

2 35: 7. 44 0-7*2)1,1) j. 7. 9320- 6*Z (2,2) | 7. 920-6*2)3,3) j 4. 87o-6*2)5,5| 

236: 1. 435So-5*2(6,6| ; -lo-5*Z(2, 6) ; 4. doe 6*Z(3,5) 

237: Z(2,6| *2(6,21 |2(3,5)*2(5,3| ' . ‘ . 

233: q to 253 
2 39: if r 1 3>5 ;qto 373 

2 40: 1. 02 e-6* 2 1 1,1 1 1 2. 004o- 6 *2 [2 ,2 1 ; G. 92 4e-6 *2(3,31 » 7. 33i)o-5*Z (5,5) 

2 41: 1. 895 750-5-2(6,6 1 ; -6.010-6*2(2 ,61 ; 2. 2 4 2c- 5* 2 1 3,5 ) 

242: 2 (2 ,61 *2|6,2| :2(3,5)*Z(5, 3) 

243: q to 253 

244: do? MilPUr FLEX. C0EFF ICI Eri fS-GAMMNS" jwa It 2000 

245: eno Z (1 ,1 1 , 2(2 .2 | ,2 l 3,3 1 ,2 | 5,5) ,2 ( 6 ,61 , Z (2 ,61 ,2 (3,51 
246: Z(2,6|*2(6,2|;2(3,51*2(5,3| 

247: if r l 3 >1 ; g to 253 

248: 0*2(1,21 *2il,3)*2[l,4) *Z( 1,51 *2(1,6) 

249: 0*2(2 ,1| *Z(2,3| *Z (2, 4) *2(2,5) 

250: 0*Z[3,l| *Z(3,2| *2(3,4) *2(3,6) 

2 51: 0* 2( 4,1) .2(4,21*2(4,3] *2(4,4] *2(4,51*2(4,61 
2 52: 0*Z(5, 1| *2(5, 2 | *2(5, 4|*2 (5, 6) *2(6, 1| *2(6, 3| *2 [6, 4) *2(6, 5) 

2 53: .flat COR 

254: mat 2R*5 

255: mat PS*T 

255: if rl3>l;qto 259 

257: mat NT»X 

253: q to 261 

259: mat Nf*Y 

260: ata Y*X*X 

251: 1+ cl 3*rl 3 

262: if rl3<*5;gto 134 

253: ds? "Print En-J-Kf foctoc Arm Flex.?";wait 2000 

264: ds? " 1“YES , 0-*NO ";wait 2000 

255: ent r22 

256: if r22*0;gto 271 

257: wrt 6,“E.J0 EFFECTOR ARM FLEXIBILITY IN TilE UUST-P ITCil SYSTEM" 

268: 1* r2 3 

269: wrt 6. 3,X(r23,l| ,X(r 23,2) ,X ( c 2 3,3) ,X(c23,4| ,X(c23,S| ,X(r23,6| 

270: Uc2 3*r2 3;i£ r23<*6;gto 269 
271: l*rl6 

272: l*rl7 . . 

273: 1 * r L 3 

274: if rlG* rl 7;gto 278 
275: 0*V |r 15 , rl 7) 

276: 1> rl 7*rl 7 

277: I* rl 3 »rl J ; -j to 274 

270: 1 *V|t 15 , rl 7| 

279: 6frl7*cl7 
280: HrlJ*rl3 
231: if rl3*rl7:<ito 278 
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232 : 0*vMrl6,tl8| 

283i i f i l J< J.»; ho 200 
294i ImUmU 

' 205: if t lu<*):jto 272 

236: 4*rl6 • 

23 7: l»rl 7 

i 2 33: 0*V|rl6,rl7|*V|l»rL6,l4rl7| •V|2»rl6,2*rl7| 

239: Iw|rl6,3*rl7| ♦V|i»rl6,4*rl7) ♦V12»rl6,5»cl?| 

. 200: 6«el/*rl7 * 

K 291: if rl7<-31j<jtO 2 80 

292: 4*:16 
, 293: l »rl 7 

* 294: 0W|rl6,4»rl7| *V |r 1 6 ,5* rl 7) 

295: 6» el 7 *rl 7 

2 93 1 if :17<«31;9to 294 , 

'> 297: I»rl6*rl6 

293: if rl6>5|<jto 304 • , 

239: 1 • tl 7 

300: 0-VU I6,3»rl7| - V [c 16,5*cl7| 

301: 6* rl7»rl7 
302: if rl7<»31i<]to 300 
303: 9to 297 
304: l»rl 7 

• 305: 0*V|rl6,3*rl7| • V (r 1 6 , 4 ♦ r L 7) 

< 306 : 6* cl 7*rl 7 • 

307: if cl7<*31*<3 to 305 

303: 0W14,32| *V|4,33|*V(S,31| *V(S,3 3] *17(6,311 *V(6,32| 

309: rdra Z(6,6| 

310: .it.it V.i»i 

311: dap "Print Tite JACOBIAN ?"j.vait 2000 
1 312: dsp " 1"Y0S , 0"NO ";wait 2000 

313: ent t22 
314: if r2 2*0: ^ to 320 
t 315: wet 6. 1 

310: wet 6 > "JACOB l AM FOR Till S AR.l CONP . IN TdB t.’RI ST-P I 'fCiI SYSTEM* 
, 317: 1* t2 3 

v 313: wet o. 3 , Z |e 2 3,11 , Z [r 2 3 ,2 J ,Z |e » 3 ,31 , Z |c2 3 ,4| , 2 Ic2 3 , 5| , Z |c2 3 ,6| 

319: 1» r2 3*c2 3: if r23<-6s?to 313 

320: rdA 0|6,6| ,*|6,t>| ,316, til ,1*15,51 , N(5,l| ,011.51 ,Pt5,ll,Vll,l| 
v 321: ten Z*0 

322: inv O»0 
32 3: inv Z* L 

t 324: .-nat XO»R 

32 5: .nat ZR*3 

325: dsp “Print Joint Flex. Matrix ?*;wait 2000 
C 32 7: dap “ 1-YES , 0«Nd "jwait 2000 

323: ent r22 
329: if r2 2*0;.)to 335 
( 330: wet 6.1 

3 31: wrt 6 , "JOINT FLEXIBILITY MATH l X* 

332: 1* c2 3 

v 3 33: wet 6. 3,3 |r 2 3,1| ,3 (r 2 3,2 1 ,S |c 2 3,3| ,5 (r2 3,4| ,3 (t2 3,51 ,3 (c 2 3,6| 

334 : ,1» ri l*r2 3; if r23<“6j'jto 331 
335: 1 » 1 1 o 
336: l*rl 7 
337: l*el . 

333: l.tlJ 
l 339: l*c20 

340: if rl6*rl7;]to 347 
34 l: if rl6- eld; jto 144 
342 : S (e l 7, rl3| •r|cl9,(20| 

34 3: I*r2d*r20 
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34 4 1 1* rlJ-rld 

34 5 1 it r 1 3 < • d j .) t o 341 

34 o i It ■ • — - •• • • • » • • • •• 

347: 1* tl 7 *rl 7 
34 J t it i 1 7<*6; jto 333 
343: rl6*rl3 
JbJ: 1 >(l 7 

351: l»rl9’ 

332: it rl3*rl7:?to 335 
333: S|rl7,rlJ| •Nlrl9,l| 

334: I*rl9*rl9 
333: Itil7-rl7 
330: it rl7< a 6;>jto 332 

337: trn N»Q • 

333: inv T*T 
339: .aat TN*P , 

360: .nat 0P»V 
361: rdra R|6,l| 

362 : S|rl6,rl6| -J|l,l| *RlrU,lJ 

363: l»rlo«rl6 

364: it rl6< a 6:i)to 336 

363: t.nt 4 , cl 1. 4 ,1 x, el 1. 4 ,lx, el 1. 4 , 1 *, el 1. 4 , 1 x, cl 1. 4 ,1 x, cl 1. 4 
366: wr t 6.1 

367: wet 6 , “JOINT FLEXIBILITIES FOR THE TOR3UE MOTOR ftODEL* 

363: wrt 6. I 

369: wrt 6,“ SHOULDER SHOULDER ELBOW WRIST WRIST 

370: wrt 6 ," YAW JT. PITCH JT. PITCH JT. PITCH JT. YAW JT. 

371: wrt 6," 

372: wrt 6. 4 , A 1 1 .1 ) .it |2 , II ,ft[ 3, U ,R I 4 .11 , R 1 3,1 1 , R 1 6 ,1| 
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